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Abstract 

An  important  Issue  in  designing  manipulators  for  dynamic  performance  is  the  determination  of  the  acceleration 
properties  of  (some  reference-point  on)  the  end-effector  of  the  manipulator.  Given  the  dynamical  equations  of  the 
planar  two  degree-of-freedom  manipulator  and  a  set  of  constraints  on  the  actuator  torques  and  on  the  rates-of- 
changes  of  the  joint  variables,  we  systematically  develop  (a)  the  properties  of  the  linear  mapping  between  the 
actuator  torques  and  the  acceleration  of  (some  reference-point  on)  the  end-effector  and  (b)  the  properties  of  the 
(non-linear)  quadratic  mapping  between  the  rates-of-changes  of  the  joint  variables  and  the  acceleration  of  the 
end-effector.  We  then  show  how  these  mappings  can  be  combined  to  obtain  useful  acceleration  sets  -  for  example 
the  acceleration  set  corresponding  to  any  point  in  the  workspace  of  the  manipulator  -  as  well  as  the  properties  of 
these  sets. 
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1  Introduction 

An  important  issue  in  designing  manipulators  for  dynamic  performance  is  the  determination  of  the 
acceleration  properties  of  (some  reference-point  on)  the  end-effector  of  the  manipulator.  Given  the  dynamical 
equations  of  the  planar  two  degree-of-freedom  manipulator  and  a  set  of  constraints  on  the  actuator  torques  and  on 
the  rates-of-changes  of  the  joint  variables,  we  systematically  develop  (a)  the  properties  of  the  linear  mapping 
between  the  actuator  torques  and  the  acceleration  of  (some  reference-point  on)  the  end-effector  and  (b)  the 
properties  of  the  (non-linear)  quadratic  mapping  between  the  rates-of-changes  of  the  joint  variables  and  the 
acceleration  of  the  end-effector.  We  then  show  how  these  mappings  can  be  combined  to  obtain  useful  acceleration 
sets  -  for  example  the  acceleration  set  corresponding  to  any  point  in  the  workspace  of  the  manipulator  -  as  well  as 
the  properties  of  these  sets. 

It  is  useful  to  briefly  mention  the  work  done  by  others  on  related  problems.  Khatib[l,2]  sets  up  an 
optimization  problem  to  improve  the  acceleration  of  the  end-effector;  however  the  non-linear  terms  in  the  dynamical 
equations  are  accounted  for  in  somewhat  ad-hoc  fashion  (by  taking  certain  "high"  and  "low”  values  of  these  terms). 
Graettinger  and  Krogh  [3]  use  semi-infinite  programming  to  obtain  the  "acceleration-radius''  (or  "isotropic 
acceleration")  of  a  manipulator.  In  contrast  to  our  approach,  both  the  above-mentioned  approaches  do  not  yield  the 
acceleration  sets  of  the  manipulators  (defined  in  section  2)  or  the  properties  of  these  sets  or  show  how  the  properties 
of  the  sets  are  related  to  the  geometric  and  dynamical  parameters  of  the  manipulator. 

The  report  is  organized  as  follows:  The  problem  and  the  variables  of  interest  (in  the  problem)  are  defined  in 
section  2.  In  the  next  section,  we  describe  certain  decompositions  of  the  manipulator  Jacobians  which  are  useful  in 
deriving  certain  properties  of  the  linear  and  (non-linear)  quadratic  mappings.  The  properties  of  the  linear  mapping 
and  the  quadratic  mapping,  respectively,  are  derived  in  section  4  and  5.  In  section  6,  we  show  how  these  maps  can 
be  combined  to  obtained  the  acceleration  set  corresponding  to  any  point  in  the  state  space;  we  then  determine  the 
properties  of  this  set  Similarly,  section  7  is  devoted  to  determining  the  acceleration  set  (and  its  properties) 
corresponding  to  any  configuration  (or  "position")  in  the  workspace  of  the  manipulator.  In  the  final  section,  using 
the  example  of  the  planar  manipulator  in  our  laboratory,  we  address  the  computation  of  the  acceleration  sets  and 
their  properties. 
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2  Definition  of  the  Problem 

In  this  section,  using  a  simple  two  degree -of-freedom  manipulator,  we  define  the  problem  to  understand  the 
dynamic  performance  of  manipulators. 

First,  we  define  manipulator  variables  in  subsection  2.1.  In  the  following  subsection,  we  express  the 
manipulator  acceleration  in  terms  of  the  variables.  In  subsection  2.3,  we  define  the  problem  to  characterize  the 
manipulator  performance  with  end-effector  acceleration. 


2.1  Definition  of  the  manipulator  variables 

Consider  the  serial  two  degree-of-freedom  manipulator  with  two  revolute  joints  shown  in  Figure  1 .  The 
manipulator  is  assumed  to  be  rigid  with  negligible  joint  friction. 


Figure  1:  A  two  degree-of-freedom  manipulator 

Let  l ,  denote  the  length  of  link  1,  a,  the  distance  from  joint  axis  1  to  the  center  of  mass  of  link  1,  m,  the  mass 
of  link  1  and  I,  the  principal  moment  of  inertia  of  link  1  with  respect  to  its  center  of  mass  about  an  axis 
perpendicular  to  the  plane  of  the  motion.  Similarly,  let  l2,  m2  and  I2  denote  the  corresponding  properties  of  link 
2  (See  Figure  1).  We  call  these  quantities  design  variables. 

x,  and  denote  the  joint  torques,  respectively,  at  joints  1  and  2  and 

T  =  [T,  x/  (1) 

denotes  the  vector  of  joint  torque  vectors.  Let 

|x,j  5  x^,  M2  (2) 

denote  the  constraints  on  the  actuator  torques  at  joints  1  and  2.  We  define 

t  =  (X  1  lx,!  £  x^,  1*1,2}  (3) 

to  be  the  set  of  allowable  torques.  ( 


Let  (xj.x^  denote  the  coordinates,  in  a  reference  frame  fixed  to  the  base,  of  a  reference  point  P  on  link  2  (See 
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Figure  1)  and  define 

x  =  [x,  (4) 

to  be  the  vector  of  task  coordinates  in  task  space.  Let  qt  and  q2  denote  the  generalized  coordinates  of  the 
manipulator  (See  Figure  1),  qt  being  the  joint  variable  at  joint  1  and  q2  the  joint  variable  at  joint  2.  Define 

Q  -  toi  <72]r  (5) 

to  be  the  vector  of  joint  variables  in  joint  space.  If 

QiL  ^  4i  -  4iU'  (6) 

denotes  the  constraint  on  joint  variable  i,  then  we  can  define  the  workspace  w  of  a  manipulator  as 

w  *  (q  i  ^  M ,•  *  i=l2)  (7) 

Let  qj  and  q2  denote  the  joint  velocities  (the  rates  of  change  of  the  joint  variables)  q(  and  q2,  respectively. 
Define 

q  =  tai  k-i?  (g) 

to  be  the  vector  of  joint  velocities.  If 

l?,  l  ^  qi0,  *=  L2  (9) 

denotes  the  constraints  on  the  rates  of  changes  of  the  joint  variables,  then  we  can  define 

r  -  (q  I  I9.-I  S  qh,  *=1,2}  (10) 

to  be  the  set  of  all  possible  joint  velocity  vectors. 

Define  the  state  vector 

u  •=  (q  q)  *  [ ql  q2  qx  q2]r  (11) 

to  represent  the  dynamic  state  of  a  manipulator  in  the  state-space. 


The  acceleration  space  or  acceleration  plane,  A,  of  the  manipulator  is  the  set  of  all  possible  accelerations, 
x  =s  [  x'j  Xj  ]r,  where  x'j  and  Xj  are  real  numbers. 

More  formally  we  can  define 

A  =  {x  I  xe  R2}  (12) 

where  R2  is  the  real  Euclidean  plane. 

22  Manipulator  acceleration 

In  this  subsection,  we  derive  an  expression  for  the  acceleration  [4], 

X  =  (x'j  X2]r,  (13) 

of  the  reference-point  P  on  the  end-effector,  since  this  quantity  plays  an  important  role  in  our  analysis. 

The  relationship  between  the  velocity,  x,  of  point  P,  and  the  "joint  velocity”  vector  q  is  well  known: 

x  »  Jq  (14) 

where  J  is  a  (2x2)  matrix  called  the  manipulator  Jacobian.  The  detailed  expression  of  Jacobian  matrix  is  shown  in 
Appendix. 
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The  dynamic  behavior  of  the  two  degree-of-freedom  manipulator  is  described  by  the  following  equations: 

du(<?2)<?l  +  dl2(q2)ij2  -  v(<72)(q12+2q1<?2)  +  pt(q)  =  t,  (15) 

d2l(q2)q\  +  <h^2  -  v(q2)(qx2)  +  p2(<0  -  h  06) 

where  the  coefficients  d^{q2),  (ij=l,2),  v(q2),  p(<q),  (i  =  1,2  )  are  given  in  Appendix;  note  that  coefficients  dy  (ij 
» 1,2),  v(q2)  are  functions  of  only  joint  variable  q^ 

Defining 


1"  dn(q2)  dl2(q2)  1 

D(q2)  :=  I  I  (17) 

L  d2x{q2)  ^  J. 

T  o  -v(q2)  1 

V(q2)  :=  |  1  (18) 

L  v(q2)  0  J. 

p(q)  •=  (Pi(q)  p2(<\)]t  (19) 

q  =  [q\  q2]T  (20) 

and 

q2  •=  \k\2  (q\+q2jl-q\'\T  (2D 

the  dynamic  equations  (15)  and  (16)  become, 

D(*2)q  +  V^Mq}2  +  p(q)  =  t  (22) 


The  matrix  Dfqj)  is  the  mass  matrix  of  the  manipulator  and  the  vector  p(q)  denotes  the  gravitational  terms 
influencing  the  dynamic  behavior. 

A  crucial  step  in  the  acceleration  analysis  is  the  definition  of  the  skew-symmetric  matrix  V(q2)  and  the  vector 

(q)2,  which  allows  all  the  non-linear  terms  (often  called  Coriolis  and  centrifugal)  to  be  written  as  the  product  of 
V(qj)  and  (q)2.  The  notation  (  }2  is  used  to  draw  attention  to  the  fact  that  the  elements  of  the  vector  {q}2  are 

quadratic  in  the  rates-of-  changes  qj  and  q2,  respectively,  of  the  joint  variables  q,  and  q2.  Note  that  (q)2  is  not 
equal  to  q^i2-*^2- 

To  obtain  the  expression  for  the  acceleration  x  of  the  point  P,  we  differentiate  (14)  to  obtain 

x  =  Jq  +  jq  (23) 

In  Appendix,  we  show  that  the  second  term  in  (23),  J  q,  can  be  written  in  the  form 

jq  =  -E(q)(q)2  (24) 

Combining  (23)  and  (24)  we  obtain 

x  =  Jq  -  E(q){q}2.  (25) 

Defining  the  quantities, 

A(q)  a  J(q)D-'(?2). 


(26) 
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B(q)  =  -A(q)V(q)  -  E(q),  (27) 

c(q)  =  -A(q)p(q),  (28) 

it  is  easy  to  verify  that  the  expression  for  the  acceleration  x  of  the  point  P,  obtained  by  combining  equation  (22)  with 
equations  (25)  through  (28),  is  given  by 

x  =  \(q)x  +  B{q}2  +  c(q).  (29) 

Note  that  A(q),  B(q)  and  c(q)  are  position  dependent,  the  expressions  for  the  coefficients  of  which  are  given 
in  Appendix. 

If  the  manipulator  operates  in  a  (horizontal)  plane  perpendicular  to  gravity,  then  c(q)  =  0  and  (29)  becomes 

x  =  A(q)t  +  B{q}2.  (30) 

In  this  paper,  we  will  study  manipulators,  moving  in  horizontal  planes,  whose  acceleration  properties  are 
described  by  equation  (30). 


Defining 


a*  •=  [alt  <X2t]r  •=  A(q)t 

(31) 

and 

'■  (“t*  °^T  =  B(q)(q}2 

(32) 

equation  (30)  can  be  written  as 

x  =  a,  +  ot^ 

(33) 

It  is  convenient  to  think  of  ot,  as  the  contribution  of  the  torques  to  the  acceleration  of  the  reference  point  P  and 
a-q  as  the  contribution  of  the  joint-rates  to  the  acceleration  of  P,  the  sum  of  these  two  quantities  giving  us  the 
acceleration  of  P  as  expressed  by  equation  (33). 


Equation  (31)  can  be  viewed  as  a  linear,  position-dependent,  mapping  between  the  torque  vector  x  and  its 
contribution  to  the  acceleration  of  P.  Similarly  equation  (32)  can  be  viewed  as  a  quadratic,  position-dependent, 

mapping  between  the  joint  rate  vector  q  and  its  contribution  a-q  to  the  acceleration  of  P. 

2  J  Definition  of  the  problem 

The  acceleration  x  of  the  reference  point  P  of  a  manipulator,  specified  by  its  design  variables,  constraints  on 
the  torques  as  given  by  (2)  or  (3),  constraints  on  the  joint  variables  as  given  by  (6)  or  (7)  and  constraints  on  the  joint 
velocities  as  given  by  (9)  or  (10),  will  be  a  subset  of  the  acceleration  plane  A  of  equation  (12).  In  other  words,  the 
acceleration  set  for  a  combination  of  the  above  constraints  can  represent  the  dynamic  performance  of  manipulators. 
To  characterize  the  manipulator  dynamic  performance,  we  generate  four  acceleration  sets  as  follows: 

First,  we  consider  the  manipulator  acceleration  set  when  the  joint  velocity  is  zero.  Physically,  the  set 
represents  the  manipulator  dynamics  when  a  manipulator  starts  to  move.  For  the  given  set  T  of  allowable  actuator 
torques  described  by  (3),  we  define  the  set  of  all  allowable  Oj  as 
St  =  (a,  I  (3T6TX04  =  Ax)} 


(34) 
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Next,  when  the  actuator  torque  vanishes  during  the  operation  of  a  manipulator,  the  subsequent  motion  of  a 
manipulator  is  also  critical  in  manipulator  dynamics.  For  the  given  (constraint)  set  F  of  allowable  rates-of- change, 
described  by  (10),  we  define  the  set  of  all  allowable  ot^  as 

=  {o^  I  (BqeFXa^  =  B(q}2)}  (35) 

Finally,  when  a  manipulator  is  in  motion,  we  consider  two  acceleration  sets  in  the  following.  The  acceleration 
of  the  reference  point  P  corresponding  to  a  specified  state-vector  u  =  (  q,,  q2,  q,,  q2  ]r  in  the  state-space  will  be 


denoted  by  a^.  From  equation  (30),  we  write 

a,,  =  A(q)t  +  B(q)(q}2  (36) 

If  we  define  a  constant  vector  k, 

k(u)  =  k(q,q)  =  [*,,  -  a^(q,q)  =  B(q){q}2,  (37) 

then  (36)  can  be  written  as 

a,,  =  A(q yt  +  k(u)  (38) 

We  now  define  the  acceleration  set,  S„,  at  a  specified  point  u  in  the  state  space  as  follows:  For  a  given  set  T  of 

allowable  actuator  torques  described  by  (3),  the  acceleration  set  Su  at  a  point  u  =  [  q,  q  ]r  in  the  state  -  space  is 
given  by 

S„(q.q)  =  (otu  I  (u=(q,q)).  (3re  T)(xtt=A(q)r+k(u)))  (39) 

Thus  Su  is  the  image  of  the  set  T  under  the  mapping  (38). 

Finally,  at  a  given  position  q  =  [  q(,  q2  ]r  in  the  workspace  of  the  manipulator,  we  can  define  two  sets 

(sl)  1  =  '-'qc  FSu(q,q)  (40) 

(SO 2  -  nqe  (4D 


The  supremum  of  (SL)X  will  be  give  us  the  magnitude  of  the  maximum  acceleration  (in  some  direction  )  of  the 
reference  point  P  at  a  given  position  ( qt ,  q2 )  of  the  manipulator. 

The  infimum  of  (S^  will  give  us  the  magnitude  of  the  maximum  acceleration  of  the  reference  point  P 
available  in  all  direction  at  a  given  position  of  the  manipulator.  The  infimum  of  (SL)2  is  called  the  isotropic 
acceleration  in  Khatib  [1]  and  the  local  acceleration  radius  in  Kim  [5]. 

Based  on  the  above  definitions,  the  manipulator  problem  can  be  written  as  follows; 

1.  To  characterize  four  acceleration  sets,  St,  S^,  Su,  S^,  with  their  shape  and  supremum  and  infimum. 

2.  To  examine  the  behavior  of  four  acceleration  sets  Sr  S^,  Su,  SL. 

In  Section  4  and  5,  respectively,  we  study  the  properties  of  the  linear  mapping  described  by  equation  (31)  and 
the  properties  of  the  non-linear  mapping  described  by  equation  (32).  The  acceleration  properties  of  P,  obtained  by 
combining  these  two  maps,  is  discussed  in  Section  6.  In  the  next  section  we  present  a  decomposition  of  the  Jacobian 
which  is  helpful  in  the  study  of  the  aforementioned  linear  and  non-iinear  maps. 
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3  Decomposition  of  the  manipulator  jacobian 

In  this  section,  we  derive  some  little  known  decompositions  of  the  manipulator  Jacobians.  These 
decompositions  facilitate  the  derivation  of  the  properties  of  the  acceleration  properties  in  Sections  4  and  5.  Let  v 
denote  the  velocity  of  point  P  in  a  reference  frame  fixed  to  the  base  N,  (n5  n^)  be  a  set  of  dextral  orthogonal  unit 
vectors  fixed  in  N,  (aj  a^)  a  set  of  dextral  orthogonal  unit  vectors  fixed  in  A,  and  (bt  b2)  a  set  of  dextral 
orthogonal  vectors  fixed  in  B  (see  Figure  2). 


P 


Figure  2:  Description  of  the  velocity  vector. 

We  pick  nj  so  that  it  points  in  the  direction  of  the  positive  Xj  axis  and  pick  n2  so  that  it  points  in  the  direction  of  the 
positive  x2  axis  (Figure  2). 


Defining, 


r  cos^(- 

-sin  <7, 

R(qi)  :=  1 

L  sin  q, 

cos  qi 

and  referring  to  Figure  2,  we  obtain, 

[#i  a 2 —  R(<?2)  [bj  b2]r 


(i=U)  (42) 

(43) 


n2]r  =  fai  *dT- 

The  velocity  of  the  reference  point,v,  in  the  reference  frame  N  is  given  by 


(44) 


v  •  /,&,  aj  +  /2(?,+q2)  b2 
From  equation  (45),  we  obtain 


(45) 
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v*bl  =  /l<?la2*bl  (46) 

V«b2  a  *  ^l^)-  (47> 

Note  that  v  •  b}  and  v  •  b2  are  simply  the  bj  and  b2  measure  numbers  of  the  velocity  of  P  in  N.  Using  equations 
(42),  equations  (46)  and  (47)  can  be  rewritten  in  the  matrix  form, 

rvbj]  f^sin^  0  1  [q{\  (48) 

Lv*b2J  L/iC0S<72+/2  l2  J  L q2\. 

Defining, 

T  /tsin^2  0  ] 

M(qj)  :=  I  !  (49) 

L  llcosq2+l2  *2  -I* 

and  using  (S),  equation  (48)  becomes 

[v*b,  v«b2]r  =  M(q2)  q.  (50) 

Referring  again  to  the  geometry  of  Figure  2,  we  can  write, 

[v«at  =  R (q2)  [v*bj  v*b2]r  (51) 

[''•ill  v«n2]r  =  R(qx)  [y»x  ya^f  (52) 


Equation  (51)  simply  relates  the  bt  and  b2  measure  numbers  of  v  to  the  at  and  a2  measure  numbers  of  v; 
similarly  (52)  relates  the  at  and  a2  measure  numbers  of  v  to  the  and  n2  measure  numbers  of  v. 

Combining  equations  (50)  through  (52)  we  obtain 

[v*Hj  v.oj]  *  R(<?,)  R (q2)  M(q2)  q  (53) 

If  x  is  the  position  vector  of  P  with  respect  to  the  fixed  point  pivot  O,  then  from  equation  (4)  and  the  choice  of 
the  directions  of  n,  and  n2  (see  Figure  2),  we  can  write 

x  =  Xjiij  +  (54) 

and, 

v  =  x  *  i,n,  +  x2a2  (55) 

From  (55),  the  U]  and  measure  numbers  of  v  are  given  by 

[v*nj  v*n2]r  =  [it  xrf7  (56) 

Combining  (53)  and  (56)  we  obtain, 

x  =  [>i  ij]7-  *  R(<7t)  R(<72)  M(q2)  9  (57> 

Comparing  equations  (57)  and  (14),  we  obtain 

J(q)  =»  R(qx)  R(?2)  W(q2)  (58) 

Note  that  we  have  decomposed  the  Jacobian  matrix,  J(q),  into  the  product  of  three  matrices  which  depend  either  on 
q,  or  q2  but  not  both  qi  and  q2.  R(q])  and  R(q2)  are  simple  orthogonal  matrices  and  N(q2)  represents  the  kinematic 
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coupling  between  the  two  links.  In  a  similar  fashion,  we  can  show  that  the  matrix  E(q)  in  equation  (24)  can  be 
written  as 

E(q)  =  R(fll)  R (q2)  N(q2)  (59) 

where 

f  i,cosq2+/2  L  1 

N(q2)  :=  I  1 

L  -lysmq2  0  J. 

Equations  (58)  and  (59)  are  very  useful  in  deriving  the  properties  of  the  acceleration  maps  in  section  4  and  5. 


(60) 
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4  Linear  mapping 


Figure  3:  Linear  Mapping 

For  the  given  set  T  of  allowable  actuator  torques  described  by  (3)  and  represented  by  (  the  interior  and  the 
boundary  of )  the  rectangle  ABCD  shown  in  Figure  3-a,  we  defined  the  set  of  all  allowable  in  section  2  as 

Sx  —  {otj  I  (3xe  TXOx  *  AX)}. 

In  this  section,  we  simply  state  that  ST  is  the  parallelogram  A  B  C  D’  shown  in  Figure  3-b  and  we  will  derive 
three  properties  of  the  set  ST.  The  first  property  determines  the  "size"  of  Sr  as  characterized  by  its  infimum, 
supremum,  and  its  area.  The  second  property  expresses  the  qj  invariance  of  Sr  The  third  property  expresses  the  q2 
dependency  of  Sr 

The  decomposition,  expressed  by  equation  (58),  of  the  manipulator  Jacobian  is  extremely  useful  in  the 
derivation  of  the  properties  of  the  set  Sr  Combining  equation  (58)  and  (26)  we  obtain 

A(q)  »  R (<?,)  R(<72)  M (q2)  D_,(q2).  (61) 

Defining  a  matrix  P(q2)  as 

P (*2)  *  R(«i>  M(?2)  JrHq2),  (62) 

we  can  rewrite  (61)  as 

A(q)  =  R(<?i)  P(q2).  (63) 

Note  that  we  have  decomposed  A(q)  into  an  orthogonal  matrix  R(qt)  depending  only  on  q,  and  a  matrix  P(q2) 
depending  only  on  q2.  This  decomposition  facilitates  the  derivation  of  the  properties  below.  The  (i  J)  element  of  A 
and  P  will  be  denoted,  respectively,  by  a(y,  and  p(y. 

Le  A',  B',  C',  D'  denote,  respectively,  the  points  in  the  aT  -  plane  into  which  the  points  A(xlo,  x^,  B(x,0>- 
x^,  C(-xlo,  -x^,  and  D(-x]o,  x^  map.  Then  it  is  easy  to  verify  that  the  coordinates  of  A  ,  B ,  C ,  D  in  the  a,  - 
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plane  are  given  by 


A  (<*11*1  <,+a12^2fl  a2l'5l«+fl22t2o) 

(64) 

B  (Pnho^liho  a2lxlo~a22x2o) 

(65) 

C  (“^i  \xlo~a\2x2o  ~a21xlo~a22x2o) 

(66) 

D  (~aUXlo+al2x2o  ~a2\xlo+a22x2e)- 

(67) 

Since  (31)  is  a  linear  mapping,  ABCD  is  a  parallelogram;  the  equations  of  the  sides  a'b',  BC,  CD  and  DA  are 
readily  obtained  as 

AB  —a iT  -  —~^2x  +  =  °»  (aUXlo~al2Z2o-aH^aUxlo+a\2x2o)  (68) 

a\2  °22  a\2  °22 

BC  alT  ~  —^2x  +  (“T- 2o  ~  °*  (_alltlo+a12t2o-alTSallTlo+a12t2o)  (69) 

all  *21  all  °2l 

CD  — - a,t  -  — «2T  -  (-—-+—)* \0  -  0,  (-<*i}*ia-ai2x20-ait-~anxio+ai2x2o)  ^ 

a12  °22  a\2  °22 

DA  -T-*U  ~  77^21  ~  =  (~aUXlo~a\2X2oSall^aUXlo~al2‘t2o)-  (71) 

all  *21  flU  °21 

•Property  1:  The  set  St  is  a  parallelogram  whose  supremum,  infimum  and  area  are  given  by 

sup(St)  =  max[  V(p112+p212)xltf2+(p,22+p222yt2^2±2(pjjPj2+p21p22)Tlot2<,  ].  (72) 


.  ^  •  r  ^\\Pr2~P\2P2\)  Tt<>l  KP11P227P12P21)  ho^  , 

inr  (ST)  =  min(  -  -  — .  . .  .  J 


area(St)=  I 


Vp122+p222 

lll2smq2 


VPii2+P2j2 


(/j  +« j  a  j  2)(l2+m2a22)+(h'¥m2!a22s*n  242)m2h2 


1  4*lo*2o 


•Proof: 


(73) 

(74) 


If  ct(O'a'),  o(OB),  <t(OC),  cKO  D  )  denote,  respectively,  the  distances  of  the  vertices  A,  B\  C  ,  and  D'  from 


the  origin  O ,  then  the  supremum  of  ST  is  given  by 

supfs^  =  max [a(CM),  a(OB),  afO'C),  c(OD)]  (75) 

Since  A  and  C  are  equidistant  from  the  origin  O'  and  since  B  and  D  are  also  equidistant  from  the  origin,  ( 
observation  (1)  above ), 

sup(St)  =  max  [o(0'a\  o{0'B)]=  Imax  [c(AC),  o(BD )]  (76) 

where  <r(AC)  and  crfB  D)  denote  the  lengths  of  the  diagonals  AC  and  B’d’.  Combining  equations  (64)  -  (67),  (63) 
and  (42),  <r(A  C )  and  ofBD)  are  given  by 

OiAC)  =  ^(pu2+P22y*\02+(P\22+P222yX2o2+2(J’nP\2+P2\P22)XloX2o  (77) 


<3{BD)  =  V(pu2+p212>t1<,2+(pj22+p222)t2o2-2(/7up12+p2jp22)T1(,T2<,  (78) 

Therefore, 

Sup (S^)  =  max[  ^(pn2+P22ytio2+(Pi22+P222yx2o2±2(J>\lPl2+P2lP22)xloX2*  J-  (79) 


If  p(O  A'),  p(O  B  ),  p(O  C ),  p(O  D  )  denote,  respectively,  the  distances  from  O  to  A  B  ,  B  C*.  C  D  ,  D  A ,  then 


the  infimum  of  ST  is  given  by 

inf(st)  *  min[p(OA),  p(OB\  p(OC\  p(OD))  (80) 

Since  AB'  and  C  D'  are  equidistant  from  O'  and  since  B'c'  and  D'a'  are  also  equidistant  from  O ,  (observation  (2) 
above) 

inf(St)  =  min  [p(AB),  p(BC’)]  (81) 

The  distance  p  from  the  origin  to  a  general  line  ax  +  f)y  +  %sOinthe;  /  -  p^e  is  given  by 

p  a  — jjL (82) 

Va2  +  32 

Substituting  appropriate  values  of  a,  (3,  and  %  from  equations  (68)  and  (69)  into  equation  (82)  and  using  equations 
(63)  and  (42),  we  obtain 

\(P\iPztP\jPiO  Ttol  |detP(<72)|T,0 

P (AB)  =  -  - - -  =  — - - -  ■  (83) 

Ml+PlZ  VPl22+P222 

p(B'C)  -  ^M\pn~p\7Pl0  ^  _  ^detP^2)^t2o  ^ 

Ml2+P212  WW 

Substituting  (83)  and  (84)  into  (81),  we  obtain 


vPn+P2i 


.  ,  .  ldetP(?2)fclo  IdetPf^ft^ 

mf(St)  *  min( —  ■  ■  — -  -  ) 

Ml+Pz l  M\  2+P2i2 


The  det  P(q2)  vanishes  at  q2=  0,  it.  Therefore  inf  (St)  =  0  at  q2=0,  k. 

Since  the  area  transformed  by  the  linear  mapping  A  is 

f1*  f^deKAjrfr,^.  (86) 

the  area  of  the  parallelogram  is  obtained  as 

det(A)  txlo-(-Xld)]  [x2o-(^2J]  (87) 

*  det(R(^|))  det(R(q2))  det(M(?2))  detOT1^,))  4-c,^  (88) 

»  det(M(?2))  det(D-l(9!))  4x1qXj,  (89) 

/■f,sinq2 

*  1  77 - £77 - ^777“ - gr2  r  72  1  4x ***>  (90) 

(/,+m^,  i)(/2+m2a2z)+(/2+m^i2‘Lsm 
•Property  2:  q(  -  dependence  of  St 

The  supremum,  infimum,  and  area  of  the  set  ST  is  independent  of  the  joint  variable  qt.  For  two  manipulator 
positions  (q,.  q2 )  and  (q,-H(>,  q2 ), 

58  RWst(?i^2>  (9l) 

•Proof: 

St  is  a  linear  mapped  set  between  actuator  torques  and  the  end-effector  accelerations.  So,  property  2  is  proved 
if  the  vertices  of  ST(q1+<^,  q2)  are  the  simple  rotation  of  S,(q,,  q2).  Components  of  vertex  A  are 
allxl«+al2t2«  *  (cosqlp„-sinq,p21)xltf+(cosq1p12-sinqip22>t2<, 

■  cos^1(p1,Tlo+p12x2^>)-sin<7,(p2jT]o+p222o)  (92) 

a21xto+a22t2o  =  (sin<7|Pn+cosqiPi1)xIo+(sinq,p,2+c0sq1p22)t2<> 
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=  smq{(j>nxlo+pnx2l)^cos,ql{p2]xio^p22lo)  (93) 

Rewriting  equations  (92)  and  (93), 

fell zlo+ai2x2o  a2lho+a22z2olTsR(-V  fellTl o+Pnho  Pixho+Ptf^-  W 

Similarly,  other  vertices  of  S(qt+$,  qj)  can  be  shown  as  a  product  of  R($)  and  Sf(q,.q2).  Therefore, 

S -  8(^(4,^) 

•Property  3:q2  -  dependence  of  St 

The  supremum,  infimum,  and  area  of  the  set  St  depends  only  on  the  joint  variable  q2. 

We  merely  state  this  property  to  emphasize  that  the  size  of  St  depends  only  on  q2,  a  property  which  is  to  be 
expected  since,  everything  else  being  the  same,  two  positions  for  which  q2  is  identical  [i.e.  (q, ,  q2)  and  (qj ,  q2)]  are 
equivalent  from  a  kinematic  and  dynamic  standpoint.  The  property  follows  obviously  from  the  equations  (72)-(74) 
which  depend  only  on  q2. 
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5  Quadratic  mapping 

For  the  given  (constraint)  set  F  of  allowable  rates-of-change,  described  by  (10)and  represented  by  (the  interior 
and  the  boundary  of)  the  rectangle  EjFjEjF^  shown  in  Figure  6-a,  we  defined  the  set  S>  of  all  allowable  a-  in 
section  2  as  q 


Sj  =  {<^  I  OqeFXa^  =  B{q}2)} 

As  in  the  previous  section,  the  following  questions  are  important 

1.  How  is  described  ? 

2.  What  is  the  size  of  ?  Specifically,  what  is  its  infimum  and  supremum  ? 

3.  How  does  depend  on  the  joint- variables  qj  and  q2. 


5.1  Description  of 

If  we  define  a  vector 

y  ■=  Oi  y2f  •=  [V  (?i+^2)2-?i2}t  (95) 

then  equation  (32)  can  be  expressed  as 

=  B(«l)  y  -  (96) 

Therefore  the  mapping  (32)  can  be  viewed  as  the  product  of  the  quadratic  mapping  (95)  from  the  q  -  plane  to  y  - 
plane  followed  by  the  linear  mapping  (96)  from  the  y  -  plane  to  the  plane. 


The  quadratic  mapping  (95)  maps  the  constraint  set  F  in  the  q  -  plane  into  a  set  in  the  y  -  plane  which  we  denote  by 
Sj.  Then  the  linear  mapping  (96)  maps  this  set  S.  into  a  set  in  the  a-  plane  which  is  simply  the  set  s-  defined  in 
(35).  q 

We  will  therefore  first  obtain  the  set  Sy  from  the  constraint  set  F  under  the  quadratic  mapping  (95).  s-  is  then 
determined  from  Sy  under  the  linear  mapping  (96). 

5.1.1  The  quadratic  map  and  the  description  of  Sy 

Formally,  we  define  sy  as  follows: 

Sy  =  (y  I  (3qeF)(y  =  {q}2  )}  (97) 

Using  equation  (21)  we  can  write  (95)  explicitly  as 

>t  *  ?t2  (98) 

>2  ■  (?i+?2)2-?i2  (99) 

We  now  have  to  determine  the  mapping  of  (the  interior  and  the  boundary  of)  the  q  -  plane  rectangle  EjFjEjFj  into 
the  y  -  plane  as  determined  by  (98)  and  (99). 

The  notation 

Xx  -+  X  (100) 

will  be  used  to  denote  the  fact  that  the  point  X,  in  the  q  •  plane  maps  into  the  point  X  in  the  y  -  plane,  i.e.  X  is  the 
image  of  X,. 
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Figure  4:  an  available  joint  velocity  set 


From  equations  (98)  and  (99)  we  use  that  the  pair  of  points  Xjfqj,  q2)  and  X2(-qj,  -q2)  in  the  q  -  plane  both  have  the 
same  image  X(  q,2,  (qj+q^-qi2)  in  the  y  -  plane,  i.e. 

Xl&P  q2)-  ~?2>  x(-<h2'  C^i+^2)2-^2)  (101) 

Consider  the  rectangle  EjFjEjFj  in  Figure  4.  A  consequence  of  (101)  is  that  the  quadrants  OjHjEjG,  and 
OjHjEjGj  of  EjFj^Fj  both  map  into  the  same  region  of  the  y  -  plane;  Similarly  the  quadrants  OjGjFjHj  and 
OlG2F2H1  ( of  EjFjI^Fj  )  both  map  into  the  same  region  of  the  y  -  plane.  Therefore  we  only  need  to  determine  the 
region  of  the  y  -  plane  into  which  the  "upper-half”  HjEjFjfy  (of  the  rectangle  EjFjEjFj)  maps.  Formally 
HjEjFjHj  is  described: 

F  -  (q  I  (3qe  F)  (q2  >  0)J  (102) 

The  required  set  Sy  is  therefore  the  image  of  F  under  the  quadratic  mapping  (98)  and  (99).  To  determine  Sy  we  first 
need  to  establish  the  following: 

1.  the  image  of  the  points  Ot,  Hj,  Elf  Gj,  Fj,  and  ^  under  the  mapping  (98)  and  (99). 

2.  the  image  of  a  line 

q2  ~  (103) 

of  slope  m  passing  through  the  origin  Ot. 

If  O,  H,  E,  G,  F  denote  the  image  of  points  Oj,  Ht,  E,,Glf  and  Fj,  then  from  (98)  and  (99)  we  can  write 

0,  (  0,  0  )  O  (  0,  0  ) 

H\  (  ?io.  0  ),  H2  (  -qu,  0  )  -»  (  ?Xo,  0  ) 


(104) 

(105) 
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E\  (  '<l\o>  <he  )  ->  £(  ?1*2  GtlSizf-il*2)  (106) 

fl  (  «2a  )  -*  F  (  ?1<,2  ^l0-?2^2-^lO2)  (107) 

G,  (  0  7^  )  ->  G  (  0,  )  (108) 

Note  that  the  points  Hj  and  ft,  have  the  same  image  as  is  to  be  expected  from  (101).  Also,  the  origin  Oj  of  the  q  - 
plane  maps  into  the  origin  O  of  the  y  -  plane.  Using  (98)  and  (99),  the  line  (103)  in  the  y  -  plane  maps  into  the  set  of 
points 

>1  =  (109) 

>2  =  (tfi+^i)2-?!2  =  ^i(«2  +  2 m)  (110) 

Equations  (109)  and  (1 10)  are  the  parametric  equations  of  the  straight  line 

y2  =  (m2  +  2m)  y,.  (Ill) 

Therefore  a  line  passing  through  the  origin  and  of  slope  m  in  the  q  -  plane  maps  into  a  line  passing  through  the 
origin  and  of  slope  (m2  +  2m)inthey  -  plane. 

To  obtain  the  image  in  the  y  -  plane  of  the  rectangle  HjEjFjHj,  it  is  convenient  to  divide  HjEjFjE^  into  four 
triangular  sections  OjHjEj,  OjEjG,,  OjGjFj,  and  OjFjHj  and  separately  determine  the  image  set  for  each  of  these 
sections.  The  required  image  set  is  simply  the  union  of  the  four  image  sets. 

In  order  to  determine  its  image  set,  it  is  convenient  to  think  of  each  triangular  section  as  composed  of  line 
segments  passing  through  the  origin.  This  will  enable  us  to  readily  determine  the  interior  of  the  image  set. 

Image  set  of  OjH^: 


e 


Figure  5:  Image  set  of  0]HIEI 
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Let  (Sy)[  denote  the  image  set  of  the  triangle  Oj  H,E[  (see  Figure  5-a  ).  Since  a  line  passing  through  the 

origin  Oj  in  the  q  plane  maps  into  a  line  passing  through  the  origin  of  the  y  -  plane  described  by  equation  (103),  the 
image  of  the  generic  line  segment  OjPj  of  slope  m  passing  through  Oj,  shown  in  Figure  5-a,  will  be  a  line  segment 
of  slope  (m2  +  2  m)  passing  through  the  origin  O  in  the  y  -  plane.  We  now  only  need  to  determine  the  images  of  the 

end  points  Oj  ( 0, 0 )  and  Pj  ( qlo,  q2 )  of  the  OjPj  .  The  image  of  Oj,  is  of  course,  (see  equation  (104). ),  the  origin 
O  of  the  y  -  plane.  Let  P  denote  the  image  of  Pj.  Then  the  line  segment  OjPj  maps  into  the  line  segment  OP  with 
one  end-point  at  the  origin  O  of  the  y  -  plane.  All  we  need  to  do  now  is  to  determine  the  locus  of  P  as  P,  moves 
along  the  line  segment  HjEj.  Using  equations  (98)  and  (99),  the  image  of  the  line  segment  HtEj  described  by  the 
quations 

k\  *  <?!o-  (  0  *  5  ?2o  )  (H2) 

is  the  line  segment  HE,  described  by  the  equation 

>1  =  4\o2'  (  0  S  y2  <  >•  (H3) 

Furthermore  the  images  H  and  E,  respectively,  of  points  Hj  and  Ej  are  given  by  equations  (105)  and  (106). 

Therefore 

1.  the  locus  of  P  in  the  y  -  plane  is  the  line  segment  HE, 

2.  the  several  line  OjPj  of  slope  m  maps  into  the  line  OP  passing  through  the  origin  O  whose  equation  is 
given  by  (1 1 1)  and  whose  end-point  P  lies  on  the  line  segment  and 

3.  any  point  on  OjPj  maps  into  a  point  on  OP. 

Therefore  the  image  (Sy),  of  the  (interior  and  boundary  of  the)  OjHjE,  is  the  (interior  and  boundary  of  the) 
triangle  OHE,  shown  in  Figure  5-b  whose  vertices  O,  H,  E  are  given,  respectively,  by  equations  (104),  (105),  and 
(106).  (O  is  of  course  the  origin  of  the  y  -  plane!). 

Image-Set  of  OjE jGj 


Figure  6:  Image  set  of  0,EjGj 
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Let  (sy)2  denote  the  image-set  of  the  triangle  OjE1G1,  shown  in  Figure  6-a.  Using  similar  arguments  as 
above,  the  generic  line  segment  OjPt  of  slope  m,  shown  in  Figure  6-a  map  into  a  line  segment  of  slope  ( m2  +  2  m  ). 
If  P  denotes  the  image  of  Pt,  then  the  image  (Sy)2  now  reduces  to  obtaining  the  locus  of  P  as  P,  moves  along  GjEj 
in  Figure  6-a. 

From  equations  (98)  and  (99)  the  image  of  the  line  segment  G  jEj  described  by  the  equation 

92  =  92a’  (  0^  9t  ^  9ia)  <114) 

is  the  parabolic  segment  GE  in  the  y  -  plane  described  by  the  equation, 

0*2  -  92 a2)2  =  1.  (  9^ la  S  >2  -  ^Xo^lo^Xo  )•  (115) 

and  shown  in  Figure  6-b. 

Therefore  the  locus  of  P  in  the  y  -  plane  is  the  parabolic  segment  GE,  the  coordinates  of  whose  end  points  G 
and  E  are  given  by  equations  (108)  and  (106). 

The  image  (Sy)2  of  the  (interior  and  boundary  of  the)  triangle  OjEjG,  is  the  region  OEG  shown  in  Figure  6-b, 
whose  vertices  O,  E  and  G  are  given,  respectively,  by  equations  (104),  (106),  and  (108);  EG  is  a  parabolic  segment 
described  by  equation  (115). 

The  Image-Set  of  0,0^, 


Figure  7:  Image  set  of  OtE,G, 

Let  (Sy)3  denote  the  image-set  of  OjGjFj. 

As  before  the  generic-line  0]Pj  incise  0]GjF,  (  see  Figure  7-a. )  maps  into  the  line  segment  OP,  where  P  is 
the  image  of  P,. 
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In  this  case,  we  have  to  find  the  locus  of  P  as  P(  moves  along  GjFj. 

Using  equations  (98)  and  (99),  the  image  of  the  line  segment  G,F,,  described  by  the  equation. 

<?2  =  (  -9to  *  9i  *  (116) 

is  the  parabolic  segment  GF  in  the  y  -  plane  described  by  the  equations, 

(?2  “  92 <  (<ho~<l20)2'‘ho2  s  y2  *  9io2  )•  (117) 

Therefore  the  locus  of  P  in  the  y  -  plane  is  the  parabolic  segment  GF,  the  coordinates  of  whose  end-points  G  and  F 
are  given  by  equations  (108)  and  (107). 

The  image  (Sy)3  of  the  (interior  and  boundary  of  the)  triangular  segment  OjGjFj  is  the  region  OGF  shown  in 
Figure  7-b,  whose  vertices  O,  G,  and  F  are  given,  respectively,  by  equations  (104),  (108)  and  (107).  Note  that  (Sy)3 
is  not  convex. 

Image-Set  of  OjF  jH2 


Figure  8:  Image  set  of  OjFjHj 
Let  (sy)4  denote  the  image-set  of  the  triangle  01F,H2  in  Figure  10-a. 

Then  the  procedure  for  finding  (sy)4  of  the  (interior  and  boundary  of  the  )  triangle  (shown  in  Figure 

8-a )  is  the  triangle  OFH,  shown  in  Figure  8-b,  whose  vertices  O,  F,  and  H  are  given  by  equations  (104),  (107)  and 
(105). 


Image-Set  of  H ,  E  j  Ft  H2 

The  image-set  Sy  of  the  rectangle  HjEjF,!^  is  given  by 

sy  *  ui=UJ.4  (sjh- 

Sy  is  shown  in  Figure  9. 


(118) 


The  image-set  Sy  of  F  is  the  (interior  and  boundary  of  the)  region  OGEF,  shown  in  Figure  1 1,  whose  vertices 
O,  G,  E  and  F  are  given,  respectively,  by  equations  (104),  (108),  (106)  and  (107).  The  boundaries  of  OGEF  are  the 
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Figure  9:  Image  set  su 

line  segments  OG,  OF,  and  FE  and  the  parabolic  segment  GE  whose  equations  are  as  follows: 


OG 

>1  = 

0,  (  0  S  y2  5 

*1° 

) 

(119) 

OF 

y^  - 

- yv 

(  o 

s 

y\ 

*  ,(i\o  ) 

(120) 

o 

FE 

y\ =9i< 

,2  s 

>2 

<, 

(121) 

GE 

o2  - 

^2)2  = 

(  0 

£ 

y\ 

5  *1  o  )• 

(122) 

Thus  OGEF  is  completely  determined.  The  region  OGEF  is  convex,  even  though  (Sy)  3  is  non-convex.  This  is  a 
consequence  of  the  fact  that  the  non-convex  boundary  of  (Sy)3  lies  in  the  interior  of  Sy. 

It  will  be  useful  in  section  7  to  approximate  the  parabolic  segment  EG  by  a  straight  line:  consequently  the 
region  OGEF  (i.e.,  Sy  is  approximated  by  a  quadrilateral ).  Two  approximations,  shown  in  Figure  12,  which  are  of 
interest  in  the  sequel  are  the  following: 

1.  the  parabolic  segment  EG  is  approximated  by  the  straight  line  segment  EG  joining  E  and  G;  the 
quadrilateral  OGEF  which  is  the  corresponding  approximation  to  the  region  OGEF,  (sy),  will  be  called 

the  inner  approximation  to  Sy. 

2.  the  parabolic  segment  EG  is  approximated  by  the  line  segment  El  which  is  tangent  to  the  parabolic 
segment  at  E  and  which  intersects  the  y2  -  axis  at  I.  The  quadrilateral  OIEF  which  is  the  corresponding 
approximation  to  the  region  OGEF,  (sy).  will  be  called  the  outer  approximation  to  Sy. 

The  coordinate  of  I  are  given  by 
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H 


Figure  10:  Approximation  of  Image  set 


/(  0,  2^2  ). 


(123) 


5.1.2  The  linear  mapping  (96)  and  the  determination  of 

From  equation  (35),  the  desired  image  set  is  the  image  of  Sy  under  the  linear  mapping  (96).  The  matrix 
B(q)  which  characterize  the  linear  mapping  (96)  is  given  by  equation  (27).  Combining  equations  (26)  and  (27)  and 
using  the  decompositions  of  the  J(q)  and  E(q)  matrices  given,  respectively,  in  equations  (58)  and  (59),  we  can  write 
B(q)  as 


B(q)  =  R(q{)  R(?2)  {  -M (q2)  D ~\q2)  \{q2)  -  N(q2)  ). 

(124) 

Defining  the  matrix  S(q2), 

S(?2>  =  R(<72)  {  ~M (q2)  D-‘(<72)  V(?2)  -  N (q2)  ), 

(125) 

we  can  write  B(q)  as 

B(q)  =  R(qx)  S<?2). 

(126) 

Therefore  B(q)  can  be  written  as  the  product  of  a  matrix  S  which  is  a  function  of  q2  only  and  a  simple  orthogonal 
matrix  which  depends  on  qt  only. 


The  (i,  j)  element  of  the  matrices  S^j)  and  B(q)  will  be  denoted,  respectively,  by  st]  and  by. 

If  O ,  G ,  E  ,  F ,  and  I  denote,  respectively,  the  images  in  the  -  plane  of  O,  G,  E,  F,  and  I,  then  using  (96) 
we  can  write  the  following: 
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£(^t  o'  (<l\a+<hjl-<1\ol)-*E  ^^11~^12^1o2+^12^1o+^2^2,  ^21  ~^22^  1  o’+b^Q}  i  o+Qlt)^  (127) 


E(Q\ o'  (<? Io-^2^2-^  1  o2) “ > ^ ((^  1 1~^  1 2^  1  <?2+^l 2^  1  o~^2o^'  (*21~^22^1o2+^22^1o_^2o)2^  (128) 

0  (  0.  0  )  ->  o'  (  0,  0  )  (129) 

G  (  0,  -qio2  )  ->  G  (  b12^2,  b^2  )  (130) 

The  images  EF,  OE,  O  F  ,  and  OG  of  the  linesegments  EF,  OE,  OF,  and  OG  are  line  segments  described  by  the 

following  equations: 

EF  ■  -Lttj.  -  -lo^  +  (-Jli+^1^^2  =  0  (131) 

"12  "22  "12  "22 


0*£*  • 


(*1  r612)^lO2+^12^10^2  (*2 1  \o^2o>2 

OF  ■  - ^ -  =  - — - 

(ft  1 J  -b  1 2)4 1 02+*i  2(^  1  o-'?  2<^2  (^21_^22^1o2+^22^1o_^2J2 

O  G  •  ^  =  S. 

^12  ^22  <  . 

The  parabolic  segment  EG  maps  into  a  parabolic  segment  G  E . 


We  can  therefore  write:  The  image  set  Sj,  of  the  set  F  is  the  ( interior  and  boundary  )  of  the  region  EFOG , 
shown  in  Figure  11,  whose  vertices  E\  F  ,  O',  and  G  are  given,  respectively,  by  equations  (127),  (128),  (130),  and 
(129).  The  segments  E  F',  OE',  OF',  and  OG'  are  given,  respectively,  by  equations  (131),  (132),  (133),  and  (134). 
Thus  is  completely  determined. 


Figure  11:  Image  set 
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5 2  Properties  of 

In  this  section,  we  derive  expressions  for  the  supremum  and  infimum  of  S^. 

5.2.1  Furthest  vertex  of 

We  first  show  that  the  furthest  vertex  of  is  E.  Inspection  of  equations  (1 19)  through  (122)  shows  that  the 
furthest  vertex  of  the  set  Sy  is  E.  Since  the  set  is  the  image  of  Sy  under  a  linear  mapping,  the  furthest  vertex  of 
is  the  image  of  the  furthest  vertex,  E,  of  Sy.  Therefore  E  is  the  furthest  vertex  of  S^. 

5.2.2  Supremum  of 

The  supremum  of  is  the  distance  of  the  furthest  vertex  E  from  the  origin.  Using  equation  (127),  we  obtain 
SUp  (Sq)  = 

[('yll-s12)2+^,s21~J22)2J^lo4+^122+s222^^l«+^2o)4+2f5't2^11_-r12^22^21“,y22^^1o2^lo+?2^2-  (135) 

5.2 3  Infimum  of 

Since  the  origin  O  ( 0, 0 )  is  one  of  the  vertices  of  S^,  the  infimum  of  is  zero: 

inf(S^)  =0  (136) 
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6  The  state  acceleration  set,  Su 

We  defined  the  acceleration  set,  Su,  at  a  specified  point  u  in  the  state  space  as  follows: 

Definition  of  SM(q,q):  For  a  given  set  T  of  allowable  actuator  torques  described  by 
T  =  {X  I  |t4 1  £  T*.  1=1,2), 

the  acceleration  set  Su  at  a  point  u  =  [  q,  q  in  the  state  -  space  is  given  by 

S„(q.q)  *  {au  I  (u=(q,q)),  Ore  T)(xu=A(q)x+k(u))) 

Thus  S„  is  the  image  of  the  set  T  under  the  mapping  (38). 


(137) 

(138) 

(139) 

(140) 

(141) 


■  a*  +  k(q,q).  (142) 

If  we  define  a  set  Su, 

Su  *  (a,  1  (3<x,es ^(a.  =  I  04)},  (143) 

then  S„  is  the  image  in  the  -  plane  of  the  set  ST  in  the  A,  -  plane  under  the  identity  mapping  (139).  From  (142) 

the  desired  acceleration  set  SB  at  a  specified  point  u  =  ( q,  q  ]r  in  the  state  space  is  the  set  obtained  by  translating  Stt 

by  the  (constant)  displacement  vector  k  ( q,  q ).  This  process  of  generating  su  is  shown  in  Figure  12-a,  b,  and  c. 


We  can  write  Su  in  the  following  equivalent  form: 

S.  *  {0^  I  (3(^6  s,)  (a  =  a*  +  k)}  (144) 

Since  Sx  is  a  parallelogram  ABCD,  Su  and  Su  are  also  parallelograms  congruent  to  Sx  but  lying  in  the  A,,  -  plane. 
The  centroid  of  the  set  Stt  has  coordinates  (  otBl,  )  &  shown  in  Figure  12-c.  Loosely  speaking,  we  can  say  that 
Su  is  obtained  by  translating  St  by  ( a,,,,  )  from  the  origin. 


Figure  12:  A  state  acceleration  set 


If  A",  B\  C",  and  D”  denote,  respectively,  the  images  in  the  -  plane  of  points  A,  B',  C’,  and  D’  in  the  \  - 
plane  (Figure  3-a),  then  from  equations  (137)  and  (64)  through  (67),  we  obtain 

A  ^au'tlo+a12X2o*fl21xlo+a22x2o)  A  (*t+anTVo+a12T2o>  lc2+a2lZlo+a22X2c)  (145) 

B  (allXlo~al2X2o<a2lzlo~a22X2o)  B  ^l+allX\o~al2x2o<  ^2+a2\X\o~a22X2c)  (I46) 

C  (~allxlo~al2X2o~a2lXlo~a22Z2o)  C  (^l~allxlo~al2X2o’  *c2~a2\Xlo~a22X2o)  047) 

D  (~al\xlo+a\2x2o’~a2lxlo+a22x2o)  ^  ^\~aUXlo+a\2X2o'  ^2~a21Tl0+<,22T2o)•  (14-8) 

Su  is  the  ( interior  and  boundary  )  of  the  parallelogram  ABCD.  The  sides  AB",  BC,  CD",  and  D"a"  of  the 
parallelogram  are  obtained  by  (137)  and  equations  (68)  through  (71), 

■  »  1  1  <>11  kn 

A  D  *  ^  4  ^  1  /  11  .  .  /  1  .  _  A  /  a  a  r\\ 


llT  ~  +  (■ 


flll  *21. 
a12  °22 


*\o  +  (- 


a12  °22 


-)  =  0 


■u  -  ♦  <-J^  * 

°2i  an  °2i 


(-_U_L)  =  o 

au  °2\ 


1  1  ®11  ^21  ^1  ^2 

— ~  — * — )Xi0  +  * — )  =  0 

*12  *22  *12  *22  *12  *22 


1  ,  *12  *22. 
jix  ~  — — -  (~ — + — ~y^2 
*21  *11  *21 


*11  *21 


-)  =  0. 


62  Supremum  of  Su 

The  supremum  of  Su  is  a  measure  of  the  largest  acceleration  available  ( in  some  direction )  at  a  specified  point 
in  the  state-space.  In  a  similar  manner  to  that  of  St,  the  supremum  of  SH  is  obtained  as  the  distance  of  the  furthest 
vertex  of  the  parallelogram  A  B  C  D"  from  the  origin  O"  of  the  A„  plane. 


If  /( O  A" ),  /(  0"B"  ),  l{  0"C" ),  and  /( O  D")  denote,  respectively,  the  distances  of  the  vertices  A",  B\  C ",  and 


26 


D"  from  the  origin  0\  then  from  (145)  through  (148)  we  obtain 

KO" A')  =  ^l+anTlo-KJ12X2^2+^+a2l'tlo+a22T2^2  (153) 

=  V(*1+<xnTlo-a12T2o)2+(*2+a2ixt<,-fl22x2o)2  (!54) 

1(0  C)  =  ^1-<,HX1o-<J!2X2i^2+(^2~,221X1<?_<*22X2^2  (155) 

/(0"D")  =  V(t1-fl11xlo+«12t2fl)M*2-021t  lo+OnhJ*  (!56) 

The  supremum  of  S0  is  given  by 

sup(Su)  =  max[  1(0' A"),  1(0'b\  l(0'c\  1(0  D ")  ]  (157) 


6J  Infimum  of  Su 

The  infimum  is  the  maximum  isotropic  acceleration  for  a  certain  manipulator  position  in  the  workspace. 
To  obtain  the  infimum  we  must  consider  three  cases 


(a) 


(b)  and  (c) 


(d) 


Figure  13:  the  relative  location  of  a  parallelogram  to  the  origin 

1.  The  origin  O  lies  outside  the  parallelogram  ABCD  and  O"  does  not  lie  between  either  pair  of 
parallel  lines  (Figure  13-a)  comprising  the  sides  of  the  parallelogram. 

2.  The  origin  O"  lies  outside  the  parallelogram  A'b'C’D"  and  0"  lies  between  A  B"  and  C  D  (Figure 
13-b). 

3.  The  origin  O”  lies  outside  the  parallelogram  A  B  C  D"  and  O"  lies  between  B  C  and  D  A  (Figure 
13-c). 

4.  The  origin  O"  lies  inside  the  parallelogram  ABCD"  (Figure  13-d). 

Using  well-known  results  from  analytic  geometry,  the  condition  for  O"  to  lie  between  the  parallel  lines  A  B  and 
C  D"  is  obtained  from  (149)  and  (151)  as 


condition  1: 
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a12  ^22  al2  *22 

the  condition  for  O"  to  lie  between  the  parallel  lines  B'C  and  D  A  is  obtained  from  (150)  and  (152)  as 
condition  2: 

all  <*21  all  °2l 

Using  the  above  two  conditions,  the  three  cases  can  easily  be  identified  from  the  following  rules: 

•  case  1:  both  conditions  1  and  2  are  false. 

•  case  2:  condition  1  is  false  and  condition  2  is  true. 

•  case  3:  condition  1  is  true  and  condition  2  is  false. 

•  case  4:  both  conditions  1  and  2  are  true. 

The  infimum  for  the  three  cases  is  obtained  as  follows: 

case  l:(Figure  13-a) 

In  this  case,  the  infimum  is  the  distance  of  the  closest  vertex  of  AB"C“d"  from  the  origin  O".  Therefore 

inf(Su)  =  min[  1(0" A),  l(0'B\  1(0* C),  l(0>  D  )  )  (160) 

case  2:(Figure  13-b) 

In  this  case  the  infimum  is  the  distance  from  the  origin  to  the  nearest  side,  which  is  either  A  B"  or  C  D", 
let  d(  a"B”  )  and  d(  C”d"  )  be,  respectively,  the  distances  from  O"  to  sides  A"Bn  and  C"d". 
dlAB)4(CD)  -  l^al‘a22-aI2a21>Tltf±(a22*ra12*2^ 

In  a  manner  similar  to  obtaining  the  infimum  of  Sr  the  infimum  of  Su  is  obtained  from  equations  (161)  as 
inf(Su)  =  min[  d(A"B"),  d(C  D)  ] 

case  3:(Figure  13-c) 

The  nearest  side  is  either  B  C"  or  D  A",  let  d(  B  C" )  and  d(  D  A” )  be,  respectively,  the  distances  from  O  to  sides 
BC  and  DA". 

«BC)AD*)  =  (163) 

Van2+a2t2 

The  infimum  of  SB  is  obtained  from  equations  (163)  as 

inf(Stt)  =  min[  d(B'c\  d(D  A~)  ]  (164) 

case  4:  (Figure  13-d)  The  infimum  is  the  distance  from  the  origin  to  the  nearest  side  which  could  be  either 
A"b",  B"C\  C  D",  or  D  A".  These  distances  were  computed  for  cases  2  and  3  above.  Therefore, 

inf(Su)  =  min(  d(AB\  d(B~C),  d(CD\  dip  A)  ] 


(161) 


(162) 


(158) 


(159) 


(165) 
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To  summarize  the  results  of  this  section  we  can  state  the  following  lemma. 

Lemma:  The  acceleration  set  Su  at  a  point  u  in  the  state-space  of  the  manipulator  is  a  parallelogram  with 
centroid  located  at  the  point  (  kj,  kj  )  defined  by  equations  (37);  the  supremum  of  Su  is  given  by  (157)  and  the 
infimum  of  Sa  is  given  by  one  of  equations  (160),  (162),  (164),  and  (165).  The  supremum  and  infimum  of  Su  is 
independent  of  the  joint  angle  qt. 

7  Local  acceleration  sets 

At  a  given  position  q  =  [  qj,  q2  ]r  in  the  workspace  of  the  manipulator,  we  could  define  two  sets  in  section  2 
(S^l  = 

(S^ 2  =  fSu<<M> 

The  supremum  of  (S^  will  be  give  us  die  magnitude  of  the  maximum  acceleration  (in  some  direction  )  of  the 
reference  point  P  at  a  given  position  ( qt ,  q2 )  of  the  manipulator. 

The  infimum  of  ( S ,)2  will  give  us  the  magnitude  of  the  maximum  acceleration  of  the  reference  point  P 
available  in  all  direction  at  a  given  position  of  the  manipulator.  The  infimum  of  (S^)2  is  called  the  isotropic 
acceleration  in  Khatib  [1]  and  the  local  acceleration  radius  Kim  [5]. 

7.1  Determination  of  (S^ 

The  generic  member  su  of  the  set  (SL)j  was  described  in  section  6  and  is  shown  in  Figure  9.  As  q  is  varied, 

Sq  is  a  parallelogram  which  moves  parallel  to  itself.  The  locus  of  the  centroid,  ( kj,  kj ),  of  the  parallelogram  as  q  is 
varied  is  simply  the  boundary  OGEF  of  the  set  shown  in  Figure  11.  Therefore  we  can  describe  (S[)x  as 
follows:  The  local  acceleration  set  (S^j  is  the  region  swept  out  by  the  parallelogram  Su  as  its  vertex  moves  along 
the  boundary  O  G  E  F  .  This  is  shown  in  Figure  14. 

12  Supremum  of  (S^ 

The  supremum  of  (S^  is  simply  the  distance  of  the  origin  from  the  furthest  point  of  (S[)y 

To  determine  the  furthest  point  of  (S^j,  all  we  need  to  do  is  to  determine 

1.  the  furthest  vertex  of  O  G  E  F’, 

2.  the  parallelogram  at  the  furthest  vertex,  and 

3.  the  furthest  vertex  of  this  parallelogram 

In  section  5,  we  showed  that  E'  is  the  furthest  vertex  of  OGEF.  The  distances  d(OA£'),d(OB  g),  d(  O  C  g ),  d( 
O  Dg  )  of  the  vertices  of  the  parallelogram  with  centroid  E  are  given  by  (153)  through  (156).  The  supremum  of 
(Sjr_)j  is  now  readily  obtained  as 

sup(S^)j  =  max[  d(OAg),  d{0'Bg),  d(0'Cg),  d{QDg)  ]. 


(166) 
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Figure  14:  Determination  of  (S^), 


Figure  IS:  A  local  supremum 


13  Determination  of  (S^ 

Using  reasoning  similar  to  that  in  the  above  section  we  can  describe  (S^)2  as  follows:  The  local  acceleration 
set  (s^)2  is  the  largest  region  common  to  all  the  parallelograms  generated  by  moving  the  generic  parallelogram  su 
along  the  the  boundary  O  G  E  F". 
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Figure  16:  (S^  and  a  local  infimum 


7.4  Infimum  of  (Sl)2 

The  infimum  of  (s^  “  the  maximum  distance  to  the  origin  from  the  boundary  of  (SL)2. 

To  determine  the  infimum  of  (S^2.  the  inner  and  outer  approximation  of  the  set  in  section  5  (and 
consequently  the  boundary  OGEF  )  are  useful. 

The  problem  of  determining  the  infimum  corresponding  to  an  approximating  quadrilateral  reduces  to 
examining  the  parallelograms  with  centroids  at  the  vertices  of  the  approximating  quadrilateral  since  these  represent 
the  extreme  parallelograms. 

The  procedure  for  finding  the  infimum,  r,  corresponding  to  an  approximate  quadrilateral  (inner  or  outer)  is  as 
follows: 

1.  Construct  the  parallelogram  at  each  of  the  four  vertices  O',  G ,  E,  F  or  O  ,  l',  E',  F'  of  the  quadrilateral. 

Let  P,,  (i  =  1, 2, 3, 4)  denote  these  four  parallelograms. 

2.  Check  if  each  parallelogram  P,  satisfies  the  two  conditions  (158)  and  (159).  If  all  the  parallelograms 
satisfy  these  conditions,  then  an  infimum  exists. 

3.  For  each  parallelogram,  P(,  determine  the  minimum  distance,  d,,  from  the  origin  to  the  four  sides  of  P,. 

4.  Then  the  infimum,  r,  of  (S^)2  for  the  approximation  is  given  by 

r  *  infCs^  *  min (<*,,/=  1 ,2,3,4)  (167) 

Let  r j  and  r2  denote,  respectively,  the  infimum  corresponding  to  the  inner  approximation  OGEF  and  OIEF. 

We  now  need  to  distinguish  3  cases. 

•  case  1:  r2  *  min  (d;,  i  =  1, 2,  3, 4)  was  obtained  from  the  parallelogram  with  vertex  I.  In  this  case  rt  and 


31 


r2  are  different  and 

rj  <  inf(S^)2  <  r2  (168) 

•  case  2:  rt  =  min  (d|(  i  =  1,  2,  3,  4)  was  obtained  from  the  parallelogram  with  vertex  G.  In  this  case  r, 
and  r2  are  different  and 

rj  <  inffs^  <  r2  (169) 

•  case  3:  rt  is  not  obtained  from  the  parallelogram  with  vertex  G  and  r2  is  not  obtained  from  the 
parallelogram  with  vertex  I.  In  this  case  r,  and  r2  are  both  obtained  from  one  of  the  other  three  vertices 
and  therefore  r,  =  r2  and 

inf(St)2  =  r,  =  r2  (170) 

Therefore  we  either  obtain  the  inf  (SL)2  exactly  as  in  equation  (170)  or  with  tight  bounds  as  in  equations  (168)  or 
(169). 
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8  Example 

In  this  section,  we  will  illustrate  die  manipulator  dynamic  properties  obtained  in  section  4  through  7  using  a 
two  degree -of-freedom  manipulator.  First,  we  show  the  state  accelerations  at  the  vertices  of  joint  velocity 
contribution  quadrilateral  in  section  6.  The  contribution,  a,,  of  actuator  torques  in  section  4  is  the  local  acceleration 
set  with  the  zero  joint  velocity  vector.  Then,  using  the  state  supremum  and  infimum  in  section  6,  we  illustrate  the 
manipulator  state  performance.  Finally,  the  local  supremum  and  infimum  in  section  7  is  calculated. 

To  provide  an  experimental  test-bed,  we  have  built  a  two  degree-of-freedom  planar  revolute-jointed 
manipulator,  shown  schematically  in  Figure  1.  The  design  variables  of  the  manipulator  consist  of 

/,=  0.303  m 
at=  0.196  m 
m,=  2.26  kg 
0.129  kg  m2 

The  actuator  torque  set  is 

T  =  {  t  I  |t,|  £  30.  Nm,  t=  1,2), 
the  joint-velocity  set  is 

v  =  {q  I  1^1  <,  1.0  rad/sec,  1=1,2}, 
and  the  workspace  is 

W  =  {q  I  1.  £  <72  ^  n  rad)- 

We  choose  the  manipulator  position  as  q  =  [  0,  Jt/2  ]T.  Our  fust  step  is  to  calculate  the  elements  of  matrices 
A,  B  for  the  manipulator  position  as  follows; 

au=  0.000  ajj*  -58.666  a2j~1.308  &y?=- 1.308 

bu= -0.007  b12= -0.000  bjjs*  -0.247  b^-0.247 

Using  equation  (157),  the  state  supremum  at  point  O  of  section  6  are  calculated  as  1761.73  m/sec2.  Since  the 
parallelogram  of  section  4  is  the  state  acceleration  at  point  O ,  the  supremum  of  the  contribution,  o^,  of  actuator 
torques  in  section  4  is  also  1761.73  m/sec2. 

To  obtain  the  state  infimum,  two  conditions  (158)  and  (159)  are  tested.  Two  conditions  for  our  manipulator 
are  both  positive,  and  equation  (165)  for  case  4  is  used  to  calculate  the  state  infimum  for  [0,  1.57,  0,  0  1 7  The 
infimum  for  [  0, 1.57, 0. 0  ]r  is  39.22  m/sec2. 

The  local  supremum  is  the  supremum  of  the  state  acceleration  located  at  point  O  in  Figure  17.  From  equation 
(166),  the  supremum  of  position  [  0, 1.57  ]r  is  obtained  as  1761.78  m/sec2.  To  calculate  the  local  infimum,  two  sets 
of  state  accelerations  should  be  considered  as  in  section  7.  The  infimums  for  the  state  acceleration  sets  at  point  O , 
F ,  E ,  G ,  I ,  of  section  6  are  as  follows: 

point  O  point  F  point  E  point  G  point  I 

1761.73  m/sec2  1761.73  m/sec2  1761.78  m/sec2  1761.74  m/sec2  1761.74  m/sec2 

Among  these  infimums,  the  minimum  is  the  infimum  as  in  equation  (170).  So,  the  local  infimum  for  [  0, 1.57  ]r  is 
38.23  m/sec2. 


l2=  0.254  m 
&2=:  0.0941  m 
m2=  0.177  kg 
I2=  2.77xl0"3  kg  m2 
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I.  Equations  of  motion  for  a  two-degree-of-freedom  planar  manipulator 

1.  Jacobian  matrix 

The  Jacobian  matrix  J  has  the  following  components: 
ju=-/1sinq,-/2sin(q1+q2) 

j12=-l2sin(q1+q2) 

j^/jcosq^cosfqj+qj) 

j22=i2cos(q,+q2) 

When  this  relationship  is  differentiated  with  respect  to  the  time,  we  obtain  the  following  equation. 
x  =  Jq  +  Jq=Jq-E(q}2 

where  E  is  a  (2x2)  matrix  which  has  the  following  elements: 
eu=/jCos  q,+/2cos  (q, +q2) 

e12=^2COS  ^til+<l2^ 
e21=/1sinq1+/2sin(q1+q2) 

e22=i2sin  (q(+q2) 

2.  Dynamic  equation 

The  dynamics  of  a  two-degree-of-freedom  planar  manipulator  is  described  by  the  following  equation: 
D  q  +  V{q]2  +  p  =  T 

D  is  a  (2x2)  matrix  and  the  components  are  as  follows: 
d,  1=I1+m1a12+I2+m2(a22+2a2/,cos  q2+/j2) 

d,2=I2+m2(a22+a2l1cos  q2) 

d12=d21 

d22=^2+m2a22- 

V  is  also  a  (2x2)  matrix  and  has  a  following  components: 
vir° 
v12=-v 
v21=  v 
v22=  0- 

where 

v  =  m^/jsinq^ 

p=a[Pi  p2]r  is  a  vector  with  the  rank  2. 

p1=m1ga1sinq1+m2g(/jsinq,+a2sin(q1+q2)] 

P2=m28a2sin(<lrKl2> 
where  g  is  a  gravitational  constant 

3.  Acceleration  equation 


35 


The  expression  of  the  acceleration  of  the  end-effector  consists  of  three  components  as  follows: 
x=At  +  B{q}2  +  c 

where 

A  =  J  D-1 
B  =-A  V  -  E 
c=-Ap 

A  is  a  (2x2)  matrix  and  has  the  following  components: 
an=A(ind22-j  12^12) 

a12=A(-jj,d,2+ji2<lii) 

a21=^2I^22-j22^12^ 

a22=A(-j2idj2+j22<*l  l) 
where 

A=(d11d22~di22]  1 

B  is  also  a  (2x2)  matrix  and  the  elements  are  as  follows: 
bll®~va12~ell 

bi2“van~€i2 
b21~~va22~e21 
b22=va21~ ®22 

c  =  [Cj  c2]r  is  a  vector  with  the  rank  2. 

Ci-anPt+a^ 

c2=a2iPi+a22P2 
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